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ABSTRACT 


A roving vehicle capable of autonomously exploring 
the surface of an alien world is under development at 
Rensselaer Polytechnic Institute. An advanced terrain 
modeler to characterize the possible paths of the rover as 
hazardous or safe is presented in this report. This 
advanced terrain modeler has several improvements over the 
Troiani modeler that include: A crosspath analysis, better 
determination of hazards on slopes, and methods for dealing 
with missing returns at the extremities of the sensor field. 
The results from a package of programs to simulate the 
roving vehicle are then examined and compared to results 
from the Troiani modeler. 
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PART 1 


1. INTRODUCTION 

Although present funds for extraterrestrial 
exploration have been reduced for the immediate future, it 
is highly probable that at some time in the future national 
interests will once again turn towards expanding our 
knowledge of the solar system we live in. When man does 
decide to explore new worlds it will be necessary to have 
the required technological background to proceed with the 
exploration so interest in the project will not be lost 
while the technology base is being developed. Therefore, it 
is important to develop this technology required for the 
exploration of alien worlds now, before the actual 
exploration mission is planned. 

When it is decided to explore an alien world, such 
as Mars, the first step will be to send robot explorers to 
investigate the world and provide for the maximum safety of 
human explorers, if they follow. A major advantage of these 
robot explorers is that a great deal of expense will be 
saved over a human exploration mission. The main savings 
will be from excluding a return flight in the mission, thus 
costly and heavy return rockets do not have to be launched 
with the mission. Also more risks may be taken 


since a 


mission failure will not result in the loss of human life. 
This could result in more exploration and studies being 
conducted as well as less money spent on the project. 

There are many approaches being studied for 
possible robot explorers spanning the range in 
sophistication from "dumb", uncontrolled, tumbleweed type 
explorers to rocket powered gliders capable of many take 
offs and landings. One practical concept that offers a high 
degree of controlled mobility in this range of robot 
explorers is a roving vehicle. 

There are two sensor systems that would be 
necessary for a surface roving type vehicle. The first 
sensing system is a long range sensor that would provide the 
rover with the general route to follow to the destination 
while avoiding major terrain features that would slow down 
the progress of the rover. This sensor system is analogous 
to a road map for a long drive. This sensor system could be 
provided by satellites orbiting the planet or even pictures 
already taken of the surface of the planet. Large, Earth- 
based computer systems could spend a great deal of time 
preparing possible routes for the rover since the routes 
would not be required in a real-time sense. The second 
sensor system needed would be a short range system capable 
of identifying smaller hazards like small craters and 
boulders that would not be seen by the long range sensor 
system. This system would have to be incorporated as part 



of the rover in order to detect the possible hazards and 
would have to make use of computing facilities on the planet 
or the rover because of the time delay involved in 
communication with Earth-based computer facilities. 

There are many approaches for constructing a short 
range sensor system including complex video systems and 
simple laser-photodetector triangulation systems. Since the 
iaser-photodetector triangulation system takes a minimal 
amount of data and the amount of work necessary to translate 
this data into usable information is small, it is the most 
feasible approach from a computational point of view. 

The roving vehicle being developed at Rensselaer 
uses a laser-photodetector system as the short range sensor 
and previous work has been done at Rensselaer to develop 
terrain modelers to characterize the terrain as safe or 
hazardous for the rover [1,2]. These methods included 
pattern analysis, slope calculations using area analysis, 
and a sophisticated method developed by Troiani which used 
estimated slope and step-height calculations. The advanced 
terrain modeler in this report is an evolution of the 
Troiani concepts that refines some of the procedures and 
adds a crosspath analysis to the modeler. 
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PART 2 


2. SYSTEM CONFIGURATION 

The planetary rover under development at 
Rensselaer Polytechnic Institute has fc*>en divided into two 
systems, the hardware system and the software system. The 
hardware system consists of all the mechanical and 
electrical systems used by the rover, the computer 
controlling it, and the telemetry system connecting them. 
The software system is composed of all the computer programs 
used to run or simulate the running of the rover. 

2 . 1 Description of Hardware System 

The rover consists of a platform mounted on four 
individually powered wheels. Mounted on the platform is a 
two meter mast with the elevation scanning laser at the top 
and the detector array half the way up the mast. The 
platform also holds all the mechanical and electrical 
elements of the rover. 

Each wheel is powered by a 1/6 HP electric motor 
giving the entire rover the ability to climb approximately 
30 degrees or to travel at approximately 0.2 meters/second 
on level terrain. Each wheel is one half meter in diameter 
giving the rover the ability to negotiate steps less than 
0.25 meters or holes and trenches less than 0.25 meters wide 



A 



without difficulty. 


The front wheels of the rover are attached in a 
manner that allows them to be individually raised and 
lowered without affecting the roll of the rover. Thus the 
roll of the rover is determined solely by the roll of the 
rear wheels. The pitch of the rover is determined by the 
average height of the tear wheels and the average height of 
the front wheels. 


The data ot; the terrain in front of the rover are 
supplied by an elevation scanning laser/multidetector system 
mounted on a mast on the rover which scans through 
15 azimuths as shown in Figure 1. This system will simulate 
up to 32 lasers by using one laser and a rotating mirror 
system. By precisely controlling the speed of the rotating 
mirror and the timing of the laser pulses it is possible to 
fire laser pulses in 32 different elevation angles. The 
system will have 40 photo-detectors, or a configuration of 
detectors that appears to be 40 detectors to all the rest of 
the systems, mounted one meter up the mast. 


When a laser pulse is fired each detector responds 
by indicating whether it saw the reflection from the laser 
pulse. A two laser/two detector system is shown in Figure 2 
to illustrate how a multilaser/multidetector system works. 
Notice that each laser pulse intersects each detector cone 
once creating four line segments of laser-detector 






intersection. If the terrain passer through any of these 
line segments of intersection then the laser beam will be 
reflected off the terrain and the detector will sense it 
when the laser is fired. 

The computing power for the rover is provided 
through a telemetry link to a PRIME 550 computer. This 
32-bit computer has an average instruction execution time of 
approximately one microsecond. The system can take up to 
8 M-bytes of random access memory and is configured with two 
80 M-byte disk drives. 

2. 2 Description of Software System 

Presently there are two software packages in us_ 
on the Mars Rover Project. The first package is the real 
time software which actually controls the rover and makes 
the path selection decisions based on the data sent to the 
computer from the rover. The second package is the 
simulation software which models an input terrain for the 
modeling and path selection algorithms, then models the 
response of the rover from the outputs of these routines. 

The real time software consists of a modeler 
routine, a path selection routine and several system 
routines. The modeler routine takes the laser-detector data 
from the rover and determines which of the 15 azimuths are 
safe for the rover to travel and which ones are not. The 
path selection routine uses the outputs from the modeler 


routine along with the knowledge of previous hazards 
encountered and the final destination of the rover to 
determine an optimal path for the rover. The system 
routines take care of functions like translating the 
information from the telemetry link into a useful format for 
the modeler routine, translating the outputs from the path 
selection routine into a format that can be sent to the 
rover as a command, and processing the interrupts as they 
occur . 

The simulation software consists mainly of a 
modeler routine, a path selection routine, a sensor routine, 
a terrain set-up routine, and motion routines. The modeler 
and path selection routines perform the same functions as in 
the real time software. The terrain set-up routine sets up 
the model for the test terrain and stores it for later 
reference by the other routines. The sensor routine sets up 
the locations of the laser-detector intersections for the 
particular laser-detector system being used and determines 
which detector sees the terrain for each laser pulse being 
simulated. The motion routines keep track of the pitch and 
roll of the rover and whether it has collided with any 
hazards on the simulated terrain. 

The two major routines, the modeler and the path 
selection routines are common to both software packages, so 
work is in progress to integrate the two software packages 
into one system that uses common modeler and path selection 
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routines for both the real time and the simulation systems. 
This will eliminate the need to write and debug a modeler or 
a path selection routine for the simulator then, after it 
works with the simulator software, rewriting it for the real 
time software. 
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PART 3 
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3. THE TERRAIN MODELER 

The terrain modeler uses the laser-detector data 
to determine which of the 15 azimuths are safe for the rover 
to travel and which ones are not. There are several 
techniques for trying to determine whether an azimuth is 
safe but the advanced terrain modeler uses an improvement on 


the algorithm developed 

by 

Troiani. The slope 

o f the 

terrain is 

bounded and 

if 

the 

bounds are less 

than 

30 degrees 

then the terr 

a in 

is 

considered safe, 

i f the 


bounds are greater than 30 degrees it is considered 
hazardous, and anything in between is considered uncertain. 

3. 1 Historical Review 

In May of 1977 Gary Maroon submitted a report[l] 
that conducts an initial investigation into the development 
of the terrain modeler for the rover under development at 
Rensselaer. This report covered a numerical technique using 
estimation of slopes and a pattern analysis method. 

The numerical technique determined the 
intersection of each laser pulse and the center line of each 
detector cone from which the laser was detected. Then the 
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area of the cross section along that azimuth of the terrain 
was generated by connecting each of these returns. From 
this area the slope was calculated using the formulas 


SLOPE 


TAN-1 


2 * AREA 
(LENGTH ) ^ 


where the length indicated is the length of the slope being 
exam ined . 


The pattern analysis technique uses differences in 
the laser-detector returns to classify hazards such as large 
boulders, craters, positive incl inations , and negative 
inclinations. The rules for determining these four types of 
hazards were determined and shown to be reasonably effective 
in distinguishing these hazards from safe terrain. 

In May of 1978 Nicholas Troiani submitted a 
reportf2] that presented a working and tested terrain 
modeler that evolved from the numerical technicue presented 
by Maroon. Troiani simplified and improved Maroon's slope 
calculation technique by determining the height and range of 
two points on the terrain and setting the slope equal to the 
difference in the heights of the two points divided by the 
difference in range of the two points. The Troiani modeler 
also took into account the slope of the rover and the 
possibility of step hazards. This modeler detected most 
hazards, but like Maroon's work did not account for 
crosspath hazards. 
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Further work is in progress to develop new terrain 
modelers for the rover and hazard detection system at 
Rensselaer. This research has split into two branches, one 
is investigating pattern analysis methods of detecting 
hazardous terrains and the other is continuing the work done 
in the Troiani and advanced terrain modelers. 

3. 2 Acquisition and Representation of Data 

The data is collected on each azimuth scanned by 
firing a laser pulse in 32 angles. Each time the laser is 
fired each detector returns either a zero indicating that 
the particular detector did not see the laser or a one 
indicating that the detector did see the laser. 

This information is encoded immediately at the 
rover by sending back to the computer just the number of the 
detector .position that saw the laser instead of the string 
of zeros and ones. In this manner the entire array of 
information for a sweep of 15 azimuths can be stored in one 
15 by 32 array. Figure 3 shows a possible terrain 
configuration and laser-detector intersections for one 
azimuth on a 15 laser by 15 detector system. The return 
from the rover is shown below in Table 1. 


FIGURE 3 SAMPLE TERRAIN AS VIEWED BY A 

FIFTEEN LASER FIFTEEN DETECTOR SYSTEM 



LASER 123^5678 9 10 11 12 13 14 15 


1 1 2 3 5 6 7 8 10 11 12 12 13 14 15 
TABLE 1 

Laser-Detector Data Returned from Terrain in Figure 3 

Next these data are put into the more useful form 
of an array of relative values. This is done by subtracting 
the number of the laser pulse *;rom the number of the 
detector that saw the reflection from the laser. The values 
in Table 1 are shown again as a relative array in Table 2. 

LASER 1 2 3 456789101112131415 

0 -1 -1 -1 00001 1 1 0 0 0 0 
TABLE 2 

Relative Array Constructed from Data in Table 1 

In order to derive the most information from the 
relative array the laser-detector system must be set up as a 
quasi-linearized array. In a quasi-linearized array each 
laser is aimed to intersect the center of the corresponding 
detector cone at the position of level terrain. The 
corresponding detector cone is that cone which has a number 
that is the same as the number of the laser pulse. Thus, 
the array of relative values indicates the extent to which 
the actual terrain differs from being level as shown in 
Figure 4. If the detector that saw the laser pulse is above 
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FIGURE 4 QUASI - LINEARIZED ARRAY 




the detector that would have seen level ground, then the 
corresponding value in the relative array is positive. On 
the other hand, if the detector that saw the laser shot is 
below the detector that would have seen level ground, then 
the value in the relative array is negative. 

The reason the rover system at Pensselaer has 
4P detectors but only 32 lasers is because of this quasi- 
linearized array set up. By examining Figure A it can be 
seen that the last laser pulse (the higher numbered laser 
pulses) have to travel further before they intersect a 
detector field. In many laser-detector configurations this 
means that the distance to most of the detector cones is out 
of the range of the laser. Since these lasers add no useful 
data to the system, they are simply not included in the 
system design. 

A missing return occurs when none of the detectors 
indicate that the reflection from the laser pulse was seen, 
as would happen if the rover was looking at a deep hole or 
other terrain feature that blocked the detectors from seeing 
the laser pulse. Some terrain features that cause missing 
returns are shown in Figure 5. When a missing return is 
encountered the rover returns a zero for the laser firing. 
When the return is transformed into a relative array this 
zero is changed into three asterisks. The return from the 
rover and relative array for the azimuth in Figure 5 are 
shown in Table 3 and Table 4 respectively. 
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LASER 1234567891011 1213 14 15 


012356708 9 11 13 01416 


TABLE 3 


Laser-Detector Data Returned for the Terrain in Figure 5 


LASER 1 2 3 4567 8 9101112 131415 


*** - 1 - 1-1000 *** -1 -1 0 1 *** 0 1 


TABLE 4 


Relative Array for the Terrain in Figure 5 


One problem not yet discussed is the quantization 
of the data. It should be noted that each detector cone 
does not see a point but instead sees the intersection of a 
line and a cone which is a line segment. Thus, if a 
detector sees the laser reflection, this indicates that the 
terrain passes somewhere through this line segment. In 
theory this line segment can be made arbitrarily small by 
decreasing the size of the sensor cone at the cost of adding 
more detectors to the system or making the overall detector 
field smaller. 



This quantization of the input data means that the 
exact position of the terrain can not be known in a real 
system. The best that can be done is to construct an 



terrains 


envelope that contains all the possible 
representable by this data. Then if all possible terrains 
in this envelope are safe for the rover the terrain 
represented by the data must be safe. Likewise if all 
possible terrains in this envelope are hazardous for the 
rover, the terrain represented by the data must be 

hazardous. The design objective in setting up a fixed 
number of detector cones is to minimize the number of 
possible safe terrains that will be classified in the same 
envelope as hazardous terrains while keeping the overall 
detector field large enough to see that safe terrain is not 
avoided because it can not be seen. 

A significant advantage of the quantization is 
that terrain features with a low amplitude will in a sense 
be filtered out. Any terrain feature with an amplitude less 
than one half the length of the line segment of the laser- 
detector cone intersection will generally not appear in the 
laser-detector data. This inherently decreases the amount 
of information that the computer system must process, making 
the elevation scanning laser/multidetector system much more 
feasible computationally. 

Previous reports have suggested that the high 
frequency components of the terrain are also lost because of 
the sampling effect associated with the discrete lasser- 
detector system, but this turns out not to be ;$©. Even in 
the unlikely situation of poles or spikes pointed directly 


at the laser in such a manner that none of the lasers hit 
them, as shown in Figure 6, the high frequency components 
can still be detected. In Figure 6 the spikes shown 
generate missing returns and give the array of relative 
returns shown in Table 5. 

LASER 1234 5 6 7 8 9 10 11 12 13 14 15 

0 0 0 1 *** *** *** *** 0 C 0 *** *** *** *** 

TABLE 5 


Relative Array for Terrain in Figure 6 


HIGH FREQUENCY TERRAIN COMPONENTS 



3.? Definition of a Hazard 


The definition of a hazard for the planetary rover 
at Rensselaer has been kept simple to minimize the amount of 
computation that must be done to find the hazards, while 
remaining elaborate enough to encompass all possible hazards 
the rover might run into. The rover has basic capabilities 
and limitations that will be used to define a hazard. 
Because the tires on the rover are 0.5 meters in diameter, 
steps greater than 0.25 meters and craters and trenches 
wider than 0.25 meters can not be negotiated. As stated 
previously in this report, the motors are not powerful 
enough to bring the rover up a slope greater than 30 degrees 
nor are they powerful enough to maintain control over the 
rover on a downward slope less than -30 degrees. In 
addition to these specifications the roll of the rover can 
not be greater than 30 degrees. The strictness of these 
specifications is to insure the safety of the rover, but 
they can easily be changed through program inputs if they 
prove too strict. 

Using the above specifications a hazard is defined 
to be any terrain feature that would force the pitch or roll 


of the rover to be 

g reater 

than 

30 

degrees or less 

than 

-30 degrees, would 

force 

the 

rover to negotiate a 

step 

(either positive 

or negative 

i n 

height) greater 

than 


2 3 
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0.25 meters in height, or would force the rover to cross a 
crater or trench wider than 0.25 meters. Later in this 
report this definition will be translated into an algorithm 
and tests from a digital computer will be examined. 


3 . A Calculation of Upper and Lower Bounds on Slopes 


The quantization of the laser-detector data makes 
it impossible to determine the actual position of the 
terrain within the line segment of intersection between the 
laser beam and the detector cone. Through any two of these 


1 line segments an infinite number of lines with widely 

varying slopes may be constructed as shown in Figure 7. 
k Therefore, since the actual slope of the terrain can not be 

computed from the laser-detector data the upper and lower 
bounds on the magnitude of the slope must be computed for 
the terrain as shown in Figure 8. If the upper bound on the 
magnitude of the slope is less than 30 degrees then the 
magnitude of the slope of the terrain that passes through 
these line segments must also be less than 30 degrees. 
Likewise if the lower bound on the magnitude of the slope is 
greater than 30 degrees then the magnitude of the slope of 
the terrain must be greater than 30 degrees. But if the 


upper bound is greater than 30 degrees and the lower bound 
is less than 30 degrees, then the magnitude of the slope can 
not be classified as less than or greater than 30 degrees. 








The procedure for calculating the upper bounds on 
the magnitude of the slopes using the data contained in the 
relative array is shown in Figure 9 and the steps are as 
follows : 

1. Determine the lower endpoint of the line segment for 
the laser-detector intersection before the first jump 
(points labelled A on Figure 9). 

2. Determine the higher endpoint of the line segment for 
the laser-detector intersection after the last jump 
(points labelled B on Figure 9). 

3. For negative features select the same laser-detector 
intersections, but use the opposite endpoints. 

4. Compute the slope of the straight line passing 
through these two points. 

The difficulty in the procedure lies in 
determining where the jump starts and ends. The start of 
the first jump is found by scanning through the relative 
array for one azimuth, starting with the lowest laser 
firing, until a nonzero value is found. This is the start 
of the first jump. Fcanning through the relative array 
continues until a possible height differential of 

0.25 meters is found between the line segment of 

intersection before the jump and the any laser firing above 
it. If a possible height differential of 0.25 meters is 




POINT (a) 
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found then the maximum slope is calculated using the 
procedure outlined above. The start of the next jump is 
found by searching the rest of the relative array on the 
azimuth for a value that differs from the last value of the 
last jump. The process continues until the highest laser on 
the azimuth is checked. Examples of the calculation of the 
upper bounds on slopes are given in Figure 9. 

The lower bounds on the slopes are calculated in 
an analogous fashion: 

1. Determine the higher endpoint of the line segment for 
the laser-detector intersection before the first 
j ump. 

2. Determine the lower endpoint of the line segment for 
the laser-detector intersection after the last jump. 

3. For negative features select the same laser-detector 
intersections, but use the opposite endpoints. 

4. Compute the slope of the straight line passing 
through these two points. 

The beginnings and the ends of the jumps are 
calculated exactly as they were for the upper bounds except 
that the height differential must be at least 0.25 meters. 
This is to insure that any slope calculated rises above 
0.25 meters since any rise less than this is not a hazard 
regardless of how steep the slope is. 


3. 5 Analysis of the Data 

The advanced terrain modeler examines each azimuth 
of the relative array one at a time to determine which 
azimuths are safe and which ones contain hazards. Any 
terrain that can not be classified either as safe or 
hazardous is avoided once the rover gets closer than one 
meter. This is to give the rover enough distance to avoid 
the possible hazard. 


The initial test for a safe azimuth is whether 
there are enough consecutive missing returns to imply the 
presence of a hole or trench wider than 0.25 meters across. 
If the missing returns start at a distance of less than one 
meter from the rover then the azimuth is immediately flagged 
as hazardous and the next azimuth is examined. If the 
string of missing returns starts more than a meter from the 
rover and does not include the final laser shot on the 
azimuth, then the azimuth is marked as hazardous and the 
range to the first missing return is stored Instead of 
proceeding to the next azimuth the modeler continues in case 
any closer hazards are present. 


If the final laser pulse is included in the string 
of missing returns the azimuth is not flagged as hazardous 
unless the string starts at a range of less than one meter 
from the rover. If the last laser pulse is in the string of 
missing returns, then the terrain on the azimuth probably 
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rises outside the range of the overall detector field as 
shown in Figure 10. This normally does not constitute a 
hazard unless the slope is too steep so the rover is allowed 
to approach closer to get a better view of the situation. 

After checking for missing returns the modeler 
determines the roll of the rover in the azimuth being 
scanned by using the current pitch and roll of the rover. 
If the magnitude of the roll computed is greater than 
30 degrees then the azimuth is flagged as unsafe and the 
next azimuth is examined. If the roll computed is greater 
than 20 degrees then the modeler checks for any positive 
steps in a crosspath sense. This entails checking the 
azimuth directly to the left of the current azimuth to 
determine if any values are greater than ine corresponding 
values on the current azimuth. If any are found then the 
azimuth is flagged as hazardous and the next azimuth is 
examined. If the roll computed is less than minus 
20 degrees then the modeler checks for any negative 
crosspath steps, flagging any found as hazardous before 
continuing with the next azimuth. Then, if the magnitude of 
the roll in the current azimuth is less than 20 degrees, any 
crosspath steps greater than 0.25 meters in magnitude are 
flagged as hazards. If no hazardous crosspath terrain 
features are found then all the upper bounds on the inpath 
slope are calculated as described in Section 3.4. If no 
upper bounds on the magnitude of the slope in the azimuth 
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FIGURE 10 TERRAIN RISING OUTSIDE OF SENSOR FIELD 



have been found, then the slope is computed through the base 
of the rover and the upper point on the farthest line 
segment of laser-detector cone intersection from the rover. 
This slope is used for the upper bound on the slope of the 
terrain in the azimuth. Then the pitch of the rover in the 
azimuth being scanned is computed using the pitch and roll 
of the rover and the upper bounds on the slopes are adjusted 
accordingly. If none of the upper bounds are greater than 
30 degrees and no previous hazards were found, then the 
azimuth is flagged as being safe and the next azimuth is 
examined . 


If any of the upper bounds were greater than 
30 degrees then the lower bounds on the slope of the azimuth 
are calculated and adjusted for the pitch of the azimuth. 
If any of the lower bounds on the slope are greater than 
30 degrees then the azimuth is flagged as hazardous. If 
none of the lower bounds on the slopes are greater than 
30 degrees then it cannot be determined whether or not the 
azimuth is hazardous at this point. Since there is no 
immediate hazard on the azimuth, the modeler classifies the 
azimuth as safe and waits until it is closer to the possible 
hazard before determining whether the azimuth is actually 
safe. See Figure 11 for a flow diagram of this algorithm. 
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3.6 Comparison of Advanced Modeler with Troiani Modeler 



The Troiani terrain modeler did not calculate a 
maximum slope for any azimuth where there were no jumps 
larger than 0.25 meters in the relative array. This led to 
two difficulties, the first stemming from the fact that the 
rover can not climb a full 0.25 meters step on a slope that 
is greater than 20 degrees. This is because the effective 
slope of the climb is greater than the 30 degree climbing 
ability of the rover. The Troiani terrain modeler solved 
this problem by signaling any positive steps as hazards when 
the rover had a pitch greater than 20 degrees. Likewise any 
negative steps were also flagged as hazards when the pitch 
of the rover was less than -20 degrees. The second 
difficulty occurs when the rover is climbing a slope greater 
then 30 degrees in a manner such that the rover has a pitch 
less than 30 degrees. If the slope is relatively planar, 
when the rover looks up the slope, which is greater than 
30 degrees, it will appear as level ground in the rover 
frame of view and will not be flagged as a hazard by the 
Troiani modeler. 

To overcome these problems the advanced terrain 
modeler calculates at least one maximum slope in every 
azimuth. This also eliminates the need to search for 
obstacles when the absolute value of the pitch of the rover 
is greater than 20 degrees, a procedure that classified many 
safe terrain features as hazards even though there was 


enough information in the array of relative values to 
classify them as safe. 


A second problem in the Troiani terrain modeler 
resulted from the laser-detector configuration. The 
detector cone size is kept small in order to keep the range 
of uncertainty for each laser-detector intersection small 
but since each detector cone is adjacent to both the cone 
above and below it, the total sensor field is too small. In 
fact the rover can look at a steep, but climbable slope and 
the far end will be outside the overall sensor field so the 
last laser pulses in the azimuth are not seen by any 
detectors as depicted in Figure 10. The Troiani modeler 
flagged this as a hazard but the advanced terrain modeler 
will not flag a consecutive string of missing returns that 
includes the last laser pulse as a hazard unless the string 
extends down the slope far enough to make avoidance 
necessary. Then, as the rover moves onto the slope and 
closer to the missing returns a more accurat 0 determination 
can be made. 


Likewise, Figure 12 shows how the first laser 
pulse will not be seen by any detectors for moderate 
downgrades. Since these returns are so close to the rover, 
they should not be ignored as in the case with the missing 
returns at the end of the azimuth. This situation is 
improved -significantly by adjusting the laser pointing 
angles so that the first laser pulse intersects a detector 


38 


FIGURE 12 TERRAIN DROPPING BELOW SENSOR FIELD 



r 

i 

! 
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i 

* 

field other than the first one at level ground. This will 
leave some "unused" detector cones below level ground for 

! 

* the first laser pulses in case the terrain does slope 

downward. A multilaser/multidetector system with the laser 

1 j 

angles aimed in this manner is shown in Figure 13. 

l i 

P " A final problem that none of the previous terrain 

modelers considered is the problem of crosspath hazards, or 
j ha za rds that would cause the rover to have a roll greater 

I l than 30 degrees. The data from the elevation scanning 

| 5 laser/multidetector system is inherently difficult to 

analyze accurately in a crosspath sense. Figure 14 depicts 
the rover, some points where the terrain is being sampled, 
and the projection of the rover along one of the azimuths. 
Notice that an approximation to the crosspath difference in 
the height of the two azimuths can be made by comparing the 
heights of the same laser pulse on two azimuths. Since the 
terrain in front of the rover is sampled in a semicircle 
pattern, this approximation will only hold for azimuths 
adjacent to each other; thus this approx imat ion can not be 
used to calculate the slope of the crosspath as was done in 
the inpath. Instead, the advanced terrrain modeler uses 
this approximation to search for any hazardous steps in the 
crosspath sense. Then an approx imation to the slope of the 
rover in that azimuth is made by assuming that the terrain 
is planar and projecting the pitch and roll of the rover 


into the azimuth being examined. 


FIGURE 13 LASER-DETECTOR CONFIGURATION WITH FIRST LASER 





Finally a test is made that is similar to the test 
for an obstacle on a 20 degree slope made by the Troiani 
modeler. If a crosspath slope with a magnitude greater than 
20 degree is detected, then any crosspath step in the same 
direction as the slope is flagged as hazardous. This is 
because a step with a height of 0.25 meters on a slope 
greater than 20 degrees could cause an effective slope 
greater than 30 degrees. 

These improvements result in an advanced terrain 
modeler that rejects more hazardous terrain configurations 
and accepts more safe terrains than previous modelers. 
Results from tests of the advanced terrain modeler are shown 
and explained in the next section. 


PART A 


4. SIMULATED PERFORMANCE AND RESULTS 

Once the terrain modeler routine was written an 
optimal laser-detector configuration was chosen and the 

entire system was tested. Tests were chosen to compare the 
advanced modeler with the Troiani modeler and to determine 
how well the advanced modeler performed when problems such 

j 

as crosspaths and complex terrains were encountered. 

4 . 1 Evaluation of Detector Cone Size for £ 

32 Laser / 40 Detector System 

This section will explain the procedure for 

choosing an optimal detector cone size for the rover under 
development at Rensselaer, then present the results of a 
search for the optimum cone size. The rover at Rensselaer 
has a 32 laser/40 detector system and uses the advanced 

terrain modeler explained earlier in this report. The use 

5 

of a different terrain modeler or a different laser/detector j 

1 

system could affect the optimum cone size, but the method j 

j 

for determining the optimum cone size would be the same. ’ 

In choosing a detector cone size, the objective is 
to keep the size of the detector cone as small as possible 
while still maintaining a large enough overall sensor field 
to see all the possible terrains. If the overall sensor \ 

field sees level ground from one meter to two meters in 

< 

1 

J 
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front of the rover then the rover, which is traveling at 
0.2 meters/second and taking one scan every second, will be 
able to make about five scans of each possible hazard. When 
looking at an uphill slope the rover will see less of the 
terrain and thus will have fewer scans of each feature. 
Likewise, while looking at a downhill slope the rover will 
see more of the terrain and thus will have more scans of 
each feature. These phenomena are shown in Figure 15. It 
is of no use to the rover to see at ranges closer than 
0.5 meters, since the rover is only designed for forward 
motion and it could not avoid obstacles that close without 
reversing itself. Likewise, the line segments of 
intersection become too large at ranges greater than 3 or 
4 meters severely limiting the usefulness of the data at 
these ranges. Also the maximum range of the laser beam 
starts to become a problem at these distances. 

In setting up the laser/detector configuration, 
missing returns at the far end of the detector field, as 
shown in Table 6, pose no problem because the advanced 
terrain modeler ignores them. On the other hand, missing 
returns close to the rover are a serious problem so the 
lasers and detectors must be set up to avoid them for safe 
terrains. To solve this problem the first laser should hit 
level ground at the center of one of the detector cones 
numbered between four and seven, to leave enough detector 
cones below the first laser to see a 20 to 25 degree 
downslope . 
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TABLE 6 


Illustration of Missing Returns at the Far End 
the Relative Array 
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The actual specifics for the laser/detector 
configurations are computed as shown in Figure 16. The 
range for the intersection of the first detector cone and 
level ground is chosen, usually about 0.7 meters. From 
this, the pointing angle of the first detector cone can be 
computed using the formula: 


Angle 


TAN“1 


Range 

height 1 or getect g T 


but since the height of the detector array is one meter this 
formula reduces to the Arc Tangent of the range. For a 
range of 0.7 meters the first detector angle is about 
25 degrees. 

Next the detector cone that the first laser will 
intersect at level ground is chosen. For a 0.75 degree cone 
size the seventh detector cone was chosen. The pointing 
angle of the start of the detector cone that sees the first 
laser pulse is the pointing angle of the center of the first 
cone plus the cone size times the number of the detector to 
see the first laser pulse minus one and a half. The one 
half is subtracted because the angle of the leading edge of 
the cone is desired, not the center of the cone. For the 
example being used this angle is: 


35.0 + 0.75 * (7 - 1 - 1/2) = 39.1 deg. 


- 48 - 





Thus the range of the detector cone that sees the first 
laser pulse on level ground is the tangent of 39.1 degrees, 
which is 0.8 meters. 

The location of the end of the last detector cone 
to see a laser pulse at level ground is found by taking the 
tangent of the sum of the start of the first detector cone 
to see a laser pulse and the cone sizr times the number of 
lasers. For the above example this location is: 

TAN (39.1 + 0.75 * 32) = 2.0 meters 

The results of these calculations are given for four 
different cone sizes in Table 7. 


size of 
senso r 
field 
( deg rees ) 


cone size range to t of first closest 
detector detector laser 
cone field 

(degrees) (meters) to see hit 

laser (meters) 


farthest 

laser 

hit 

(meters) 


30 

0.75 

0.7 

7 

0.P 

2.0 

35 

0.875 

0.7 

5 

0.8 

2.3 

40 

1.0 

0.7 

4 

0.8 

2.7 

60 

1.5 

0.5 

2 

0.5 

3. P 


TABLE 7 

Results of Cone Size Calculations 


The results of running these laser/detector 
configurations on the simulator are shown in Table 8. The 
rover was positioned in front of a hill with a slope between 
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25 and -25 degrees. If the rover went in a straight line 
from the start to the target as shown in Figure 17, then in 
Table 8 the run is labeled as "good". If the rover deviated 
from a straight line, but still reached the target as shown 


in 

Figure 18, then the run 

i s 

1 isted 

as "deviated" 

. If 

the 

rover deviated so much that 

it 

did 

not 

reach 

the target 

then 

the 

run is listed as "almost" 

and 

if 

the rover did 

not 

even 

try 

to negotiate the slope 

the 

run 

is 

listed 

as "no 

good 

n 

• 


Slope 


Cone 

Size 



( degrees) 


(deg rees) 




0.75. 

0.875 

1.0 


1.J5 

30 

No Good 

No Good 

No Good 

No 

Good 

25 

Almost 

Good 

Almost 

No 

Good 

20 

Good 

Good 

Deviated 

No 

Good 

15 

Good 

Good 

Good 

Good 

-15 

Good 

Deviated 

Good 

No 

Good 

-20 

Deviated 

No Good 

No Good 

No 

Good 

-25 

Almost 

No Good 

No Good 

No 

Good 

-30 

No Good 

No Good 

No Good 

No 

Good 


TABLE 8 

Results of Computer Simulations on Varying Cone Sizes 
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FIGURE 17 


ROVER ADVANCING TO TARGET IN 
DIRECT COURSE 
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FIGURE 18 


ROVER ADVANCING TO TARGET IN 
DEVIATED COURSE 
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Note in Table P that a 
generally performed 
cone size results in a 
and thus a better 
Table 9 which lists th 
each cone size. On 
entry, the other entri 
rover moves onto the 
in parentheses is the 
slope . 


s the cone size got smaller the rover 
better. This is because the smaller 
smaller line segment of intersections 
estimate of the slope as is shown in 
e estimates of the slopes made for 
slopes where there is more than one 
es are estimates of the slope as the 
slope in a straight line and the pitch 
pitch of the rover as it looks at the 


In Table 9 there are several values for the upper 
bound on the slope enclosed in parentheses that seem much 
larger than the rest of the estimates of the slopes. These 
slopes are generated because at the end of the azimuth the 
advanced terrain modeler drops the requirement that the 
upper bound have a possible 0.25 meter jump. This insures 
that a last upper bound on the slope is calculated on the 
azimuth, but sometimes results in an overly large slope 
because the data points a used to calculate the slope are so 
close together in height and range. 


5 4 




Also note in Table 9 that the lower bounds on the 
slopes are much closer to the actual value of the slopes 
than the upper bounds on the slopes. This is because of the 
terrain set up used rather than any inherent superiority of 
the lower bound calculations over the upper bound 
calculations. The terrain was constructed of long, not too 
steep slopes. Since the lower bound calculations are not 
made until the smallest possible jump is greater than 
0.25 meters, the points used in the lower bound calculation 
tend to be more separated and estimate the long slope better 
than the upper bound calculations that use points which are 


closer 

together 

. If the 

terrain had instead 

been short. 

steep. 

step- like 

slopes then 

the 

upper bound 

calculations 

would 

have resulted in closer 

estimates to 

the actual 

slopes 

• 






From all this testing the best cone size for the 
32 laser pulse/40 detector system to be used at Rensselaer 
in conjunction with the advanced terrain modeler is 
0.75 degrees. This sees from 0.P meters to 2.0 meters in 
front of the rover on level terrain providing that the first 
detector cone is set up to intersect level ground 0.7 meters 
in front of the rover and the seventh detector cone sees the 
reflection of the first laser pulse off level terrain. 
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Modeler 


The advanced terrain modeler has three functional 
differences from the terrain modeler developed by Troiani. 
The advanced modeler performs a crosspath analysis, it 
ignores missing returns at the far end of the relative array 
and it computes at least one upper bound on the slope in 
each azimuth. Since the Troiani modeler did not compute 
crosspath slopes, no comparison is warranted on this 
subject. The effect of the advanced modeler ignoring the 
far missing returns is that the laser/detector configuration 
can have smaller detector cones with the advanced modeler, 
allowing a more accurate estimate of the slope of the 
terrain. The effects of varying detector cone sizes were 
discussed in the previous section. Since the advanced 
terrain modeler computes the slope in every azimuth it does 
not have to check for any steps on azimuths with slopes 
greater than 20 degrees as the Troiani modeler did. 

Figure 19 shows the simulated running of the rover 
up a 20 degree slope with a 0.1 meter block on it under the 
advanced terrain modeler. It is seen that the advanced 
modeler has no problem recognizing that this terrain is 
safe. Figure 20 shows the rover attempting to negotiate the 
same terrain under control of the Troiani modeler. After 
the slope of the rover has attained 20 degrees the rover 
sees the return shown in Table 10. Since the slope of the 
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REAR WHEELS 


FIGURE 19 

ROVER CLIMBING 20 DEGREE SLOPE WITH A SMALL BLOCK 
WITH THE ADVANCED TERRAIN MODELER 
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REAR WHEELS 


FIGURE 20 


ROVER CLIMBING A 20 DEGREE SLOPE WITH A SMALL BLOCK 
WITH THE TROIAN I MODELER 
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ro/er is 20 degrees the Troiani modeler considers this 
terrain a hazard. The advanced modeler computes that none 
of the slopes are greater than 25 degrees and thus has no 
trouble with the slope. 


AZIMUTH I 2 2 f 5 6 7 6 9 30 12 12 13 14 35 

LASER 

32 00222227222220P 

31 002222222222200 

30 002222222222200 

20 00 2 2222 2. 2222200 

28 002222222222200 

27 001222222222100 

26 001 2 22222222100 

25 000222222222000 

24 000222222222000 

23 000222222222 000 

22 000227222222000 

21 000122272221000 

20 000122222221000 

IP 000022222220000 

18 00022222222 0 000 

17 000022222770000 

16 000012222210000 

15 000012222210000 

14 000002222200000 

13 000001222100000 

12 000001222100000 

11 000000111000000 

10 000000010000000 

9 000000000000000 

8 000000000000000 

7 OOOOOOOOOOOPOOO 

6 OOOOOCOOOOOOOOO 

5 COO 0 00000000000 

4 000000000000000 

3 000000000000000 

2 COO 0 00000000000 

1 000000 000000000 


TABLE 10 

Relative Array from Rover on a 20 Degree Slope 
Looking at a 0.1 Meter High Block 



4.3 Tests of Advanced Modeler on Slopes with Varyin< 


Crosspaths 


The running of the rover was simulated on several 
slopes under control of the advanced modeler with crosspath 
slopes varying from 15 to 30 degrees. Since the terrain 
that the rover was looking at had the same slope as the 
rover, the relative array was all zeros as shown in 
Table 11. When the crosspath slope was less than 30 degrees 
the rover progressed straight to the target as shown in 
Figure 21. On slopes greater than or equal to 30 degrees 
the rover did not go anywhere because of the crosspath slope 
ahead of it and the possible inpath hazards going up and 
down the slope. 


The same tests were run with a block in the path 
that showed up in the relative array as shown in Table 12. 
With a 15 degree crosspath slope the rover progressed 
straight to the target without any difficulty as shown in 
Figure 22. When the crosspath slope was increased to 
25 degrees the advanced modeler determined that the block 
was a hazard and avoided the block as shown in Figure 23. 
Finally when the crosspath was increased to 30 degrees the 
rover once again stopped before going too far as shown in 
Figure 24. 
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FIGURE 21 

ROVER NEGOTIATING CROSSPATH 
SLOPE LESS THAN THIRTY DEGREES 
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FIGURE 22 

ROVER NEGOTIATING 15 DEGREE CROSSPATH 
WITH SlMALL BLOCK 
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FIGURE 23 


ROVER NEGOTIATING 25 DEGREE CROSS 
WITH SMALL BLOCK 


- 66 - 


v?>. 

, 

f ,.-. 

w f 

V 


«.61 tfUtCRSI 
9.0 (ACTCCIf 


9.JI Ml J.*J ».M 4.99 

I t E* I i 

tMf7 9 9O*t0f94f*99997f9^79"99999999999999999999t999««99499909999999997999999999499999979999999999999999«9999999999999999999999999 
99 f f 9 9 f999ftf99ft999999«999999999999999999999999999 999999999999 9999999999999999999999999999999999999999999999999999999999999999999 


*M4fl998MM*9M9f'eM9't*a9M*9M*ll<'»M90MI90MM*90*904**M«*ffnMfl0ff99M0M9flM000Mm994999M09M«0Qmfl«MM0H0MM9ISHe9*0a 


91)97 91999119 9979979719T79T9T9 919997 9 171977999719 9799 9? 17719999 917191797177 79999771997199997999 77971919 9911911991 11 9777 79 797 979 799 
79 7t 7 77 97 979 9777 9 779 9777 977 7979797 79 3171799 77 19797977 99 99799999997179977997779997 79 779977937719199 797379799779377 97 77T7777 
777777777777 177 771777777777777777777777777777777777797I7777797777 77177777 77 77 79 77977777 77777777777777 77 777 977777777777777777^ 77777 
1777177717771717777177777777777177717777771977777777771777777797777777799977777777777777779777777779977779777177717179797997777777 
1711771771171177717771771177177771117177177117777777771171117777777777777777779777777777777777717777797777777717777777777777777777 

7777T777T77777 77 7777 77 777777777777777777777777 77 777 7 7777T77777777 
11T17TTiri11T.T77TTtTTTTTT11TT7777?Tt.1TTTTTTM?.97?nmm.tJ.rmAJ 


6 5 5 1 


.£*4444664464646*45664446*644 
^664*46 6444 64 6546 66 64 464*66 


♦ ♦44606««M6«0666S«S*«*6<*<*<6*6«« 

*4 4464446 64444 46*464f, 46446666 64 56^ 

*«46«46 44644 64 666*46M64*4646646ir.*4**\4 4l***64*4*6 5466 6666 4666A4 j 

44 44446*46444 4664466646 44444**444 4446 4*546*6*465 4 6444445*546644 44 

\C ENTER OF 


FRONT AXLE 

• 55«5y.5M5»55555.55550»555MS35J55555JS5J3S5S5S55SM555«555S555| 
3»»533333?355355335533S5535555S53533»5555!5S3555S5533353'jv53S3355l 
533553355553355 i 53553S5353555535535555iS5iSS3355355!35555533553535li 


TARGET 

4 - 


66644*46464444466*66444446446446446445444166466*4666444444666666 

1 4 64 44666666 1664 66 §46441 6*6&6664*6 4664 6446 6666446 66666 46 464 5 46 6 66. 
646664644464*64666466664*66656*4446666666*64*666*666646566666666 
0406*46 6656444* 66 *4 464666 6666 664664564566666656 64 6466466* 6566 554 




I 


;block”: 


l?)ni7 3)?l)IIJ|)l33Jl)JJ3)l9l))3)l)33))IJ33)))))3)}J)37)J7))l)JJi))5l3J)))J-9)3))JI|3)33l)3JJ))l)))3)J)3))))))))3)))l))))3)3)7J3)J 
MimmjJJ 3)3 3)3 37 3 13 33 HI 33)1 >3) 1133333))) I) 33 33 U 3)3)3 3 J3JJ 3)33)3)))) J33J 3331 J) 3))J)))JJ3)3)JI)3 J)))3J)J)J 3)3) J 33 133 J3J 3 3 33)33 
13)3)3)33 JII13J3 3)3 3)3)3 3 3)11)33 3 33) 7)»)))ll )))))) 31 7)1 313 33 3) 33 JJ IJJJ 133) 3)1)3)33 ))) 3)3)31) 3 1 1)13) 3 JJ 7)3))J3))3 3J3133 3J3 33 3)3)3) 


FIGURE 24 

ROVER ATTEMPTING TO NEGOTIATE 30 DEGREE CROSSPATH 

WITH SMALL BLOCK 
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4 . 4 Test of Advanced Modeler on Complex Terrain 

Figure 25 shows a terrain consisting of a large 
crater, two smaller craters and four blocks and the path 
taken by the rover to get from the starting position to the 
target. Table 13 gives the first relative array seen by the 
rover. The level terrain outside the crater can be seen as 
all zeros. The negative numbers show the edge of the large 
crater and the positive numbers in the center azimuths are 
the returns from the small block in front of the rover. The 
missing returns just behind these are from the large block 
behind the smaller one and are caused by the fact that the 
top of the large block is outside the sensor field of view. 

The rover decides that it can not go straight 
ahead and moves forward to the left. For the second scan 
shown in Table 14 the relative array shows the same features 
as the first scan except that they are to the right of the 
relative array since the rover turned to the left. As soon 
as the rover got past the two blocks it turned to the right 
and arrived at the target as shown in Figure 25. 
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PART 5 


5. CONCLUSIONS 


The 

report is a 
safe path for 
as well as 
the 


advanced te 
viable so 
the rover a 


inpath haza 
advanced modeler. 


rrain modeler presented in this 
lution to the problem of choosing a 
t Rensselaer to travel. Crosspath 
rds are taken into consideration by 


Tests have 
configuration with 
distinguish inpath si 
minus twenty degrees 
distinguish crosspath 
range of plus or m 
Crosspath slopes with 
more difficult time, 
distinguished in the r 


shown that a 32 laser/40 detector 
a cone size of 0.75 degrees can 
opes within the range of plus or 
as safe terrain. The modeler can also 
slopes free from hazards inside the 
inus thirty degrees as safe terrain, 
hazards on them give the modeler a 
but safe terrain could still be 
ange of plus or minus twenty degrees. 


Future work on terrain modelers at Rensselaer 
should focus on two topics: more advanced methods of 
performing the crosspath analysis, and alternate methods of 
hazard detection. The crosspath analysis on the advanced 
terrain modeler depends on the current pitch and roll of the 
rover to compute the crosspath slope. It is possible to 
imagine terrains where the crosspath slope is greatly 
different from that calculated by the pitch and roll of the 


72 


rover, so methods that just use the information in the 
relative array should be developed for computing the 
crosspath. The present methods of calculating the crosspath 
will always be good as the rover approaches very close to 
the terrain being examined but new approaches might improve 
the performance of the terrain modeler at greater distances. 

The work on alternate methods of hazard detection 
could follow up on the work done by Maroon[2] involving 
pattern analysis and possibly try combining some of the 
numerical methods used in the advanced terrain modeler with 
the new techniques developed. Developments in these areas 
could provide interesting results and even suggest more ways 
to improve the numerical techniques used in the terrain 
modeler presented in this report. 
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APPENDIX 


SOURCE CODE FOR SUBROUTINES 
DEVELOPED UNDER THIS PROJECT 
(FLOW DIAGRAM IS SHOWN IN FIGURE 11) 


- MODEL3 

- CALSLP 


- Al 


o n 


SUBROUTINE MCDEL3 

cccccccccccccrccccccccccccccccccccccccccccccccccccccccccccccccccccccccc 
c c 

C THIS IS THE JUKE 1,1979 VERSION Cf SUBROUTINE MODELS C 

C THIS SUBROUTINE IS A TERRAIN MODELER WRITTEN BY ERKIN HUNTER C 

C WHICH IS A MODIFICATION CF NICK TROIANI’S CONCEPTS C 

c c 

C THE FOLLOW I NS ARE SCME CF THE ARRAYS USED IN THIS PROGRAM C 

C C 

C DATA (I, J) - ACTUAL SENSOR DATA FOR AS-1UTH I, LASER J C 

C DIAG (I , O) - DIAGONALIZED RETURN FOP ASMUTK I, LASER J C 

C POS (I,J,1) - HEIGHT OF THE ITH LASER, JTH SENSOR INTERSECTION C 

C PCS (I, .1,0) - RANGE CE THE ITH LASER, JTIJ SENSOR INTERSECTION C 

c c 

c c 

ccccccccccccccccccccccccccccccccccccccccccccccccccccccccccccccccccccccc 

COMMON /CHOOSE/ 

1 NMMOD, NMSTN , NM PS A, N M F AIL, INTVDB, T NTSEN, 

2 I N^MO D,INT?SA,INTEAL,INTGYR 
COMMON /7IEUP/ 

1 TUETNU, ALPHA , SLPI N, SLPCRS , TALLOW 

COMMON /DYNMIC/ 

1 DKNMAX,UrMAX, V5HL EN,VEHW ID, CDS MAX, VELMA X,DT, TURN 1 , 

2 STRMAX, STPMAX 
COMMON /SENS R/ 

1 A SMUTH, LA NGLS ,RTN 

COMMON /DETECT/ 

1 SENTIM, SI MST?, SEN IX M , I4K 

COMMON / S E N X / 

1 11ITLA5, HIT SEN, SUM LAS, NUMSEN , NUM A2, INTO AT, NK DTPR, LAS AGL, 

2 S ENGLE, SCON, DATA , Cl AG ,?OS,SEN 1ST 


REAL * 4 RANGE (50) , 5 ENGLE (50) , LA NILE (50) , A2MUTH (50) , LAS AGL (SO) , 
ASMUTH (50) , POS (50 ,51 ,2) 


INTEGER < 
INTEGER * 
LOGICAL < 
LIST = 6 


HAZARD (50) , RTN (50) , DIAG (50,50) , SEN 1ST 
DATA (50 , 5C) 


IS THE IN IT I AL ISA TICK SECTION 


I* (IJK . GT. 0) GO TO 5 
READ (5, 10 00) XKAX,ZNAX, BNGMIN 
i FORMAT (3F10. 5) 

IF ( I NT MOD . EQ. 1) KRITE (LIST, 1050) XMA X, ZMAX , RNG MI N 
> FORMAT (//10X, ’THIS IS THE INIT ALIZATION SECTION OF MODEL3 • , 

% //I OX , f THE MINIMUM ALLOWABLE DISTANCE FOR MISSING RETURNS IS 

1 F 10. 3, 

2 /I OX, f THE MAXIMUM STEP CLIMBAELE IS 
2 F 1 0 . 3 # 


3 / 1 OX , ’ THE MINIMUM RANGE BEFORE AVOIDING A HAZARD IS * , 

4 no. i > 

CONVRT * 130.0 / 3.14159 
3COM = 1.0 / CON VET 
URWAXD * OPMAX * CONVRT 
D'lr.AXD * DWKMAX * CONVBT 
RETURN 

5 CONTINUE 

C 

C CONSTRUCT THE DI AGONALIZED BE7URN FOS THE LASER-SENSOR DATA IS 
C AF.FAY DATA 
C 

CALL OIAONL 
DO 7 1=1,50 

HAT AH 0(1) = 1 
7 CONTINUE 

C 

C PROCESS "ACH ASMUTH, ONE AT A TIKE 
C 

DO 100 J* 1 , NOMA" 

C 

CCC NON SEARCH FOE ANY HISSING RETURNS 

r 

C NALAS TS THE LAST LASER IN EACH AZIflUTH WHICH CSLY HAS SAFE TERRAIN 
C IN FRONT OF IT 

C HAZARD = 1 KEANS THAT NO HAZARDS HAVE DSZN FOUND FOR THIS AZIMUTH YET 
C I KISS IS THE NUTTER OF CONSECUTIVE MISSING RETURNS FOUND SC FAR 
C 

NALAS = NUMLAS 
TNI S3 = 0 
C 

C FOR EACH LASER SHOT IN THIS AZIMUTH, DETERMINE IF A SENSOR DETECTED 
C IT 
C 

DO 50 1=1, NUMLAS 

C 

r. D IAG (.7, 1) 13 THE SENSGE WHICH DETECTED THE ITH LASER ON THE JTH 
C AZIMUTH 

C IF DI AG ( J, I) = 1000 THEN NO SENSOR SAW THE LASER SHOT 
C 

I* (DIAG (J, I) .LT. 1000) GO TO 30 
C 

C IF NC SENSOR SAW THE LASER SHOT THEN: 

C INCREMENT THE NUMBER CF CONSECUTIVE MISSING RETURNS 

C IF THIS IS THE FIRST CONSECUTIVE MISSING RETURN THEN SET TSTET 

C EQUAL TO THE LASER NUMBER AND TIRSTH TC THE POSITION 

C OF THE LAST HIT 

C THEN CONTINUE PITH THE NEXT LASER SHOT 

C 

IMISS = IMISS ♦ 1 
IF (INTSS .LE. 1) ISTKT = I 
GO TO 50 
10 CONTINUE 
C 

C IF TOO MANY MISSING BETURNS HERE FCIJND, THEN SET 


A3 


nnnnnnnnnnnnn on on no non noon 


RANGE = THE RANGE OF THE LAST LA5ER-SEH50R INTERSECTION WHICH 
FOUND SAFE TERRAIN ANC INDICATE THAT TOC MANY MISSING RETURNS 
HERE FOUND BY SETTING HAZARD = 2 


RANGE (4) = 0.0 

IF (ISTP.T .IF. 1) GO TC 20 

LGO0D = ISTRT - 1 

ILAS = ISTP.T - 1 

ISDN = DATA (J, HAS) 

RANGE (0) = PCS (ILAS,ISEK ,2) 

20 CONTINUE 

HAZARD { J) = 2 
G° TO 60 
30 CONTINUE 

LG HOD = T 

T r (I MISS -E2. 0) GO TO 50 

ir(I .GE. N'JV-Aj) LGCCD = ISTRT - 1 

DETE-NINE THE LENGTH OF THE MISSING RETURN FIELD 

ISDN = DATA (0,1) - I ISTRT 

DIST = A BS ( T) OS ( 1-1 , DATA (J ,T) -1,2) - POS (ISTRT, I SEN , 2) ) 

IF (DIST .GE. X M A X ) GC TC 10 

iv THE NHi'.BER OF CONSECUTIVE MISSING RETURNS FOUND WAS LESS TUAN 
THE NUMBER ALLOWABLE, THEN 

SET 01 AG AND DATA EjUAL TC THE MINIMUM CF THE SURRONDING TERRAIN 
RESET IMIS5 TO 0 

IFILI = 0 

IE (ISTRT ,GT. 1) I F ILL * 01 AG (0 , ISTRT- 1) 

IF (iriLL .GT. DI AG ( J , I) ) IFILL= DTAG(J,I) 

DO 40 K=I STRT , I MISS 
DIAG ( J , K ) = IFILL 

DATA (J, N) = IFILI ♦ K ♦ SEN 1ST - 1 
l»0 CCNT I*’UE 

IMISS = 0 
50 CONTINUE 

60 CONTINUE 


IF THE NUMBER OF CONSECUTIVE MISSING RETURNS IS NOT ZERO (EITHER 
E-'CAUSS THERE WERE .MISSING RETURNS AT THE END OF THE AZIMUTH 
OR BECAUSE MORE THAN KXMISS CONSECUTIVE MISSING RETURNS WERE 
FOUND), T|!E t | SET NALAS TC THE LAST GOOD LASER SHOT 


IF (IMISS .NE. 0) NAIAS = HOOD 


THETA IS THE SLOTE CF THE ROVER IN RESPECT TO THE CURRENT 
CFSPTli IS THE CROSS-PATH SLOTS IK THE CURRENT AFTMUTH 
ALPHA IS THE HEADING ANGLE 
SLPIN IS THE INPATH SLOPE 


AZIMUTH 


cccc 


SLPCRS IS THE CROSS PATH SLOPE 


DELTA = ASMUTH(J) ♦ ALPHA 


°°* Ql$ - * 


A4 


CCCC NOTE THH TO IMPROVE THE SPEED CF THIS MODELER THE SMALL ANGLE 
CCCC APPROXIMATION CAN BE USED FOR ASIN ( ), SIN(SLFIN), AND 
CCCC SIN (5LPCR S) SINCE THE IMPORTANT VALUES CF THESE A RF ALL LESS 
CCCC THAN 30 DEGREES* THE SMALL ANGLE APPROXIMATION CAN NOT DE 
CCCC US r D FOR DELTA SINCE DELTA COULD BE AS LARGE AS 160 DEGREES 
CCCC 

STNTN = SIN(SLPIN) 

SI NCR 3 = SIN (SLPCRS) 

COSO = COS (DELTA) 

SIND = SIN (DELTA) 

THETA = ASTN (SININ*C CS t - SINCRS*SIND) 

OUTS LP = THETA ♦ CONVRT 

CRSPTH = ASIN (SININ*SIND ♦ SINCRS*COSD) * CONVHT 
C 

CCC NOV COMPUTE THE MAXIMUM SLOPES 
C 

C LA STD IS THE DIAGONALIZED RETURN FPON THE LAST LASER SHOT 

C TLA 57 IS THE LAST LASER THAT SHOT BEFORE THE CURRENT SLOPE 

C CPMAX TELLS CALSLP TO CALCULATE THE MAXIMUM SLOPES 

C 7 MAX IS THE MAXIMUM STEP THE ROVER CAN NEGOTIATE 

C 

LASTS * 0 
I LAST a -2 
0-»MAX = .TRUE* 

Z T r . S T a 2 M A X 
C 

C IF THE CROSS-PATH FOR THIS AZIMUTH IS GREATER THAN 30 DEGREES 
C THEN FLAG THE AZIMUTH AS BEING HAZARDOUS 
C 

ILAS = 1 

I SEN 1 = DATA (7,1) 

IF (ABS (CRSPTH) . GE. 30.0) GO ?C 75 
DO 70 I - 1 f N ALAS 
C 

C — PERFORM THE CROSS-PATH ANALYSIS -- 

C ON AMY AZIMUTH , IF THERE IS A STEP DIFFERENCE BETWEEN IT AND 

C THE NEXT AZIMUTH GREATER TRAN ZMAX, THEN FLAG BOTH THE AZIMUTH 

C AND THE NEXT AZIMUTH AS HAZARDOUS 
C 

C - OR - 

C IF THE CRCSS-P ATH SLOPE OF THE ROVER ON THAT AZIMUTH 
C WOULD EE GREATER TUAN 20 DEGREES , THEN FLAG ANY POSITIVE 
C OBSTACLES AS BEING HAZARDS 

C IF THE CROSS-PATH SLOPE OF THE ROVER ON THAT AZIMUTH 
C WOULD BE LESS THAN MINUS 20 DEGREES, THEN FLAG ANY NEGATIVE 
C OBSTACLES AS BEING HAZARDS 

C 

I r (J .15. 1) GO TO 64 
ISEN1 = DATA (J,I) 

I SEN 2 = DAT A (3-1 , 1) 

IF (ISEN2 .LE. 0) GO TO 64 
ILAS = I 

IF (CRSPTH . GE. 20.0) GO TO 61 
IF (CPS PTH .IE. -20.0) GO TO 62 

IF (ABS (PCS (I, ISEN 1,1) -POS (I , ISEN2 , 1) ) . GT. ZBAX) GO TO 75 


A5 


o o n n n o o n n n n n n o noon n o o o n n no o 


6 1 

GO TO 64 
CONTINUE 




A 2 

I? ( I S2N2 .GT, I5EN1) 

GC TC 64 

courriUE 

GC 

TO 

75 

64 

IP (I5EV2 .LT. ISEK1) 
CTVTI^rJS 

GC 

TO 

75 


IF THE DIAGONALIZED RETURN DID NOT CHANGE, AND WE ARE NOT ON THE 
LAST LASER SHOT, THEN GC TO THE NETT LASER SHOT 

IF (DTAG (J, I) .EJ. LASTD .AND. I . NE. NALAS) GO TO 70 
L.A3TD = DIAG (7,1) 

ON T*: T> LAST LASER SHOT FORCE CALSLP TO CALCULATE THE SLOPE 3T 
SFTTI‘10 THE MAXIMUM STEP EOUnL TO A NEGATIVE NUMBER 
AND T“ NO SLOPES WERE CALCULATED FOR THIS AZIMUTH, THEN CALCULATE 
THE AVERAGE SLOPE FOP THE ENTIRE AZIMUTH 

T- (I . NE. NALAS) GC TO 05 
ZTEST = -1.0 

I” (HAST .LT. -1) HAST ~ 0 
05 CONTINUE 

TF -LAST = -1, THEN THIS IS THE START OF A NEW SLOPE, SO SET HAST 
EOUAL TO THE LAST LASER SHOT BEFORE THIS SLOPE 

I' 'HAST .LT. 0) ILAST = 1-1 

C* _L CALSLP ( I, I LAST, J , ZTEST, OP MAX , SLOP E, CIST) 

ir A SLOPE WAS CALCULATED, THEN ILAST WILL BE SEX TO -1 

IF NC SL^PE WAS CALCULATED, THEN THE CHANGE IN HEIGHT WAS LESS THAN 

ZMAX, SO FIND THE NEXT JUMP IN THIS SLOPE 

H (ILAST . GE. 0) GO TO 70 

IF A SLOPE WAS CALCULATED, THEN TRANSFORM IT INTO "HE PLANET FRAME 
AND INTO DEGREES (EROM RADIANS) 

AND TEST WHETHER IT IS WITHIN THE HOVER'S CLIMING ABILITY 

SIOPE = (SLQFE+THETA) *CONVBT 

IF (INTMOD . EQ. 1) WRITE (LIST , 900 ) J , OUTSLP , SLOPE 
900 FORMAT ( ' FOR THE ',12,' AZIMUTH THE SLOPE OF THE TERRAIN IS 

1 F 7 . 2 , ' DEGREES AND THE BAX SLOPE IS ',F7.2,' DEGREES') 

IF (SLOPE .LT. OPRAXD .AND. SLOPE .GT. DNKAXD) GO TO 70 

IF THE SLOPE IS HAZARDOUS, THEN INDICATE THAT IT IS 
AND END COMPUTATIONS OM It'S AZIMUTH IF IT IS TOC CLOSE 

IF (DIST .GT. RNGK1N) GO TO 80 
HAZARD (J) = 3 
RANGE (J) = DIST 

GO TO 100 
70 CONTINUE 
GC TO 100 
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c 

C IF A CROSS-PATH HAZARD SAS DETECTED, THEM MARK THE TUG 
C AZIMUTHS BEING CHECKED AND CONTINUE TO THE NEXT AZIMUTH 
C 

75 CONTINUE 

HAZARD (J) = 6 

HAZARD (.1-1 ) = C 

RANGE (J) = PCS (IDAS, ISEN 1,2) 

RANGE (.1-1) = RANGE (J) 

GO TO 100 
C 

C OTHER VISE, IF THE HAZARD IS NOT TOC CLOSE, COMPUTE THE MINIMUM SLOPES 
C 

30 CONTINUE 

C 

CCC NOW COMPUTE THE MINIMUM SLOPES 
C 

C LASTS IS THE DIAGONALIZED RETURN FROM THE LAST LASER SHOT 

C TLAST IS THE LAST LASER THAT SHOT BEFORE THE CURRENT SLOPS 

C OPMAY TELLS CALSLP TO CALCULATE THE MINIMUM SLOPES 

C 

LASTD = 0 
HAST = -1 
CPMAX = .FALSE. 

DC 90 1=1 , N ALAS 

C 

C IF THE DIAGONALIZED RETURN DID NOT CHANGE THEN GO TO THE NEXT LASER 
C SHOT 

IF (DTAG (J, I) .S2. LASTD) GO TC 90 
LASTD = CIAG (J, I) 

C 

C IF 1LAST = -1, THEN THIS IS THE STAFT OF A NEK SLOPE, SO SET I LAST 
C SOUAL TO THE LAST LASER SHOT BEFORE THIS SLOPE' 

C 

IF (ILAST .LT. 0) ILAST = 1-1 
C 

C NOK CALCULATE THE MINIMUM SLOPE 
C 

CALL CALSLP (I, 1L AST , J , ZM AX , OPM AX , S LOPE , DI5T) 

C 

C IF A SLOPE B AS CALCULATED, THEN ILAST BILL BE SET TO -1 
C IF NO SLOPE WAS CALCULATED, THEN TEE CHANGE IN HEIGHT WAS LESS THAN 
C ZMAX, SO FIND THE NEXT JUMP IN THIS SLOFE 
C 

IF (ILAST .GE. 0) GO TO 90 
C 

C IF A SLOPE SAS CALCULATED, THEN TRANSFORM IT INTO THE PLANET FRAHE 
C AND Itro DEGREES (EROM RADIANS) 

C AND TEST WHETHER IT IS WITHIN THE ROVER'S CLIMING ABILITY 
C IF IT IS, THEN FIND THE NEXT HINIMUM SLOPE 

C 

SLOPE = (SLOPEtTHETA) * CONVRT 

IF (INTMOD . EQ- 1) U RITE (LIST , 91 0) J , OUTSLP , SLOPE 
910 FORMAT ( ' FOR THE ',12,' AZIMUTH THE SLOPE OF THE TEB8AXH IS ', 
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1 F 7 . 2 , ' DEGREES AND THE KSK SLOPE IS ’,F7.2,’ DEGREES’) 

IF (SLOPE . L7. UPHAXD . AND. SLOPE .GT. DNNAXD) GO TO 90 

C IF Til" HINtKUM SLOPE IS NOT WITHIN THE ROVER'S CLIHING ABILITY THEN 

r THE S! OPE IS DEFINITELY A HAZARD AND SHOULD BE AVOIDED 

C 

HAZARD (J) = 4 
RANGE (J) = niST 
GO TO 100 
30 CONTINUE 

IP ( H AT A RR ( J) . EQ. 1) HAZARD (J) = 5 
100 CONTINUE 

C OUTPUT DATA ON AZIMUTHS 

WHITS (0,1100) 

1100 r OR NAT (’1 • , ’AZIMUTH* ,46X, 'TERRAIN CHARACTERS ATION • , 4 IX , ' RTN ’ ) 
DO 20000 J*1,KURA3 
I=H AZAED (J) 

GO TO(1 10, 120, 130,140, 15C, 160) , I 

no r.TN(j) = i 

WRITE (6,12500 ) J 

12500 r OR NAT ( '0' , 3X,I2,5 y , 'CESTACLES DETECTED ARE NOT HAZARDOUS. ' 

1 ,' TERRAIN IS PASSABLE. ' ,52X,'1') 

GO TO 20000 
120 H IN ( J) =0 

WRITE (6,6500) J, RANGE (J) 

6500 FORMAT ( '0 • , 3X, 12, 5X, 'HISSING RETURNS DETECTED BEGINNING', 

1 ' AT A RANGE OF ',F3.1,' HETERS. TERRAIN IS NOT PASSABLE.', 

2 25 y , ' O' ) 

00 TO 20000 

130 STN (J) =0 

WRITE (6,9500) J, RANGE ( J) 

S500 FORMAT (’0* ,3X,I2,5X,' OBSTACLE DETECTED AT *,F3. 1, ' METER RANGE* 

1 ,' KITH POSSIBLY HAZARDOUS SLCPE. TERRAIN BILL BE AVOIDED.' 

2 1 3X , '0 •) 

GO TO 20000 

14 0 F. 7N ( J) =0 

K RITE (C, 1 0500) J, RANGE (J) 

10500 FO?EAT('0',3X,I2,5K, ' CBSTACLE DETECTED AT ’,F3.1,' DETER RANGE ', 

1 'WITH DEFINITELY HAZARDOUS SLCPE. TERRAIN IS NOT PASSABLE.' 

2 1CX,'0») 

GO TO 20000 

150 ETN(J) = 1 

WRITE (6,1 1500) J 

11500 FORK AT (’O’ , 3X,I2,5X,' POSSIBLE OBSTACLE DETECTED BUT NOT CLOSE • 

1 'ENOUGH TO NECESSITATE AVOIDANCE. • ,38X,’1’) 

GO TO 20000 
160 CONTINUE 

RTN(J) = 0 

WRITE (LIST, 12000) J , RAN GE (J) 

12000 FOR SAT (’0',3K,I2,5X, 'HAZARDOUS CROSS PATH DETECTED AT RANGE ', 

1 F 1 . 1 , • HETERS, TERRAIN IS NOT PASS ABLE. ', 36X ,’ O’ ) 

20000 CONTINUE 
RETURN 
END 
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SUBROUTINE CALSLP (I,TLAST,IASM,ZMAX, OPMAX, SLCPE, XLAST) 
cccccccccccccoccccccccccccccccccccccccccccccccccccccccccccccccccccccccc 
C C 

c 
c 
c 
c 
c 
c 
c 
c 
c 
c 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC'CCCCCCCC 
COMMON /SE NX/ 

1 HITLAS, HITS EM / K'JMLAS, NUMSEK ,NUMAX,I NTDAT , NMDTPR, LASAGL, 

2 5SN3LE, 3COM, DATA , El AG ,?OS,SSN1ST 

REAL * 4 PG 5(50(51,2) , l ASAG1 (50 ) , SENGLE (50) 

INTEGER * 4 DIAG(50,5C) ,SEN1SI 

INTEGER * 2 DATA (50,50) 

LOGICAL * 1 OPM AX 


THIS TS SU3ROUTINF CALSLP SKICJJ CALCULATES THE MAXIMUM 
on MINIMUM SLOPES rcn MCDE13 

IF OPMAX IS TRUE, THEN THE MAX SLCPE BILL BE CALCULATED 
OTHERWISE THE MINIMUM SLOPE WILL CALCULATED 
ZMAX IS THE MAXIMUM SLOPE THE ROVEP. CAN HANDLE 
SLPPF IS THE VALUE CF THE SLCPE RETURNED BY THE SUBROUTINE 
IT A 5LO n E TS CALULATED EY THIS ROUTINE, THEN I LA ST IS SET 
TO -1 TO IN DT CAT EC THAT THE VALID SLOPE WAS CALCULATED 


IF ILAST IS NEGATIVE, THEN SET IT TO ZSP.O INCASE NO SLOPE 
IS CALCULATED 

IF (ILA3T .LT. 0) IL AST = 0 
YLAST = 0.0 
LSEN = 0 
XLAST =0.0 

IF HAST IS NOT ZERO, THEN CALCULATE HHICI1 SENSOR SAB THE F1BST 
VALID LASER SHOT 

IF (HAST ,GT. 0) LSEN = DIAG (IASM, ILAST) 

C 

C IF YOU ATE COMPUTING THE MAX SLOPE AND THE SLOPE IS GOING: 

C - UPHILL THEN ADD 1 TO THE LAST LASER IN THE SLOPE 

C - DOWNHILL THEN A ED 1 TO THE FIRST LASER IN THE SLOPE 

C IF YOU ARE COMPUTING THE MIN SLOPE AND THE SLOPE IS GOING: 

C - UPHILL THEN ADD 1 TO THE FIRST LASEP IN THE SLOPE 

C - DOWNHILL THEN ADD 1 TO THE LAST LASER IN THE SLOPE 

C 

M ® 0 

IF (DIAG (TASM,I) .LT. LSEN) N = 1 
IF (.NOT. OPM AX) N = 1 - N 
I” (ILAST .IE. 0) GO TO 10 
LSEN = DATA ( IAS M, ILAST) ♦ N 
YLAST = POS (7LAST,LSEN,1) 

10 CONTINUE 
N = 1 - N 


ORIGINAL PAGE IS 
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NOV COMPUTE THE SENSOR THAT SAV THE LAST VALID LASER SHOT 

NSEN = DATA (IASH,I) ♦ N 
TN2W = POS (I ,NSEN , 1) 

IF THE CHANGE IN HEIGHT IS NOT GREATER THAN ZHAX, THEN RETURN 

DSLTY = TNEK - HAST 
IF (ABS (DELTT) .LT. ZHAX) GO TC 20 

OTHERWISE COMPUTE THE NEW SLOPE 

IF (ILAST .GT. 0) XLAST = POS ( ILA ST , LS ES, 2) 

XNEK = POS (I / NSEN, 2) 

DELTX = AB S ( XNE V - HAST) 

SLOPE = ATAN (DELTY/DELTX) 

ILAST = -1 
20 CONTINUE 
RETURN 
END 
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